program main_lr_st
use studentscr
use matrixfuns
use datahadler
use stestmod2
use ghlliks
implicit none
integer, parameter:: TT=1000,nn=3,S=10000,ngrid=10
integer, parameter:: nvar0=2*nn+6
integer,parameter:: nvar=nvar0+nn+1
integer iparam(7),T,n,i,j,sit,seedvec(S),seedind(2)

double precision:: y(TT,nn),ytot(TT,nn)&
				 &,thscale(nvar),rparam(7),a1,a2,c9

double precision:: thlb(nvar),thub(nvar),thtrue(nvar),th0(nvar)&
				 &,th(nvar),llik,grad(nvar),therr(nvar),lika,likb,tha(nvar),thb(nvar)

double precision:: mth(S,nvar),lr(S)

double precision:: gra(nvar),grb(nvar),sigrid(ngrid)&
&,llikf,llikj,llik1,matthshape(S,nn+2)

!double precision, parameter:: pi=3.14159265358979d0,eta_h1=-.05,p_si=.95d0,b(3)=(/-1.0d-1,-1.0d-1,-1.0d-1/)
!double precision, parameter:: pi=3.14159265358979d0,eta_h1=.2,p_si=.3d0,b(3)=(/-1.0d-1,-1.0d-1,-1.0d-1/)
!double precision, parameter:: pi=3.14159265358979d0,p_si=.999d0,b(3)=(/-1.0d-10,-1.0d-10,-1.0d-10/)

double precision, parameter:: pi=3.14159265358979d0,eta_h1=.2,p_si=.3d0,b(3)=(/-0.05d0,-0.05d0,-0.05d0/)
!double precision, parameter:: pi=3.14159265358979d0,p_si=.999d0,b(3)=(/-1.0d-10,-1.0d-10,-1.0d-10/)

				 
common T,n,y

!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
T=TT
n=nn
call rnset(1)
!!!!!!!!!!True parameters
a1=.1d0
a2=.85d0
c9=.999d0

thtrue(1:n)=vassign(n,.2d0)			!delta
thtrue(n+1:2*n-1)=vassign(n-1,1.0d0)	!c
thtrue(2*n)=0.05d0					!alpha0
thtrue(2*n+1)=0.05d0				!phi0
thtrue(2*n+2)=dasin(dsqrt(a1/c9))    !alpha1
thtrue(2*n+3)=dasin(dsqrt(a2/(c9-a1)))   	!alpha2
thtrue(2*n+4)=dasin(dsqrt(a1/c9))		!phi1
thtrue(2*n+5)=dasin(dsqrt(a2/(c9-a1)))	!phi2
thtrue(2*n+6)=.2d0
!call readvec(thtrue,2*n+6,"pstheta.txt",1)

!!!!!!!!! Limits

thlb(1:n)=vassign(n,-1.0d2)			   !delta
thlb(n+1:2*n-1)=vassign(n-1,-1.0d2)		   !c
thlb(2*n)=1.0d-10					   !alpha0
thlb(2*n+1)=1.0d-5					   !phi0
thlb(2*n+2:2*n+5)=vassign(4,0.0d0)
thlb(2*n+6)=1.0d-2 !1.01d-3
thlb(2*n+7)=5.0d-2 !1.0d-2
thlb(2*n+8:3*n+7)=vassign(n,-100.0d0)


thub(1:n)=vassign(n,1.0d2)			   !delta
thub(n+1:2*n-1)=vassign(n-1,1.0d2)		   !c
thub(2*n)=1.0d2 					   !alpha0
thub(2*n+1)=1.0d2					   !phi0
thub(2*n+2:2*n+5)=vassign(4,2.0d0*pi)
thub(2*n+6)=0.499d0
thub(2*n+7)=0.99d0
thub(2*n+8:3*n+7)=vassign(n,100.0d0)

thscale=vassign(nvar,1.0d0)

sigrid=linspace(1.0d-1,.99d0,ngrid)
!sigrid=linspace(.90d0,.99d0,ngrid)


call readvecint(seedvec,S,"seedsimst.txt",1)
call readvecint(seedind,2,"seedind.txt",1)


do sit=seedind(1),seedind(2),1
print*, sit

call rnset(seedvec(sit))

!!!!!!!!!!Simulation
call ghsimul2(nvar0,T,n,thtrue(1:nvar0),eta_h1,b,p_si,ytot)
!call ghsimul1(nvar0,T,n,thtrue(1:nvar0),eta_h1,b,p_si,ytot)
!call stsimul(nvar,T,n,thtrue,ytot)


y=ytot(1:T,1:n)
!goto 10

!!!!!!!!!!Estimation
    thlb(2*n+6)=1.0d-3

call du4inf(iparam,rparam)
iparam(3)=1000
iparam(4)=1000
iparam(5)=1000
!rparam(1)=1.0d-7
!rparam(2)=1.0d-15
call dbcong(stllik,stscr,nvar0,thtrue(1:nvar0),0,thlb(1:nvar0),thub(1:nvar0)&
          &,thscale(1:nvar0),1.0d0,iparam,rparam,th(1:nvar0),llik)


therr=dabs(thub-th)*dabs(th-thlb)
call dsvrgn(nvar0,therr(1:nvar0),therr(1:nvar0))

mth(sit,:)=th
if (therr(1)>0.0d0) then
	llikf=llik
	th(nvar0)=.2d0
	th(nvar0+1)=0.95d0
	th(nvar0+2:nvar)=vassign(n,0.01d0)


	call stllik(nvar0,th(1:nvar0),llikf)

!call ghllik(nvar,th,llik)
!call dfdgrd(ghllik,nvar,th,thscale,llik,0.0d0,gra)
!print*, "one"
!call ghscr(nvar,th,grb)
!do i=1,nvar,1
!	print*,th(i),gra(i),grb(i)
!end do
!	stop
	!thshape0=thshape

	do i=1,ngrid,1
		th(nvar0+1)=sigrid(i)
		call ghllik(nvar,th,llikj)
		if (llikj<llikf) then
			th0=th
			llikf=llikj
		end if
	end do
	!!
    !thlb(2*n+6)=-10.0d0

	!!GRID
	call erset(0,0,0)
	call du4inf(iparam,rparam)
	iparam(3)=200
	iparam(4)=1000
	iparam(5)=1000
	call dbcong(ghllik,ghscr,nvar,th0,0,thlb,thub&
          &,thscale,1.0d0,iparam,rparam,th,llik1)

	lr(sit)=max(-2.0d0*(llik1-llik),0.0d0)
    matthshape(sit,:)=th(nvar0:nvar)
	print*,sit,real(lr(sit)),real(mth(sit,2*n+6)),real(th(2*n+6:2*n+7))


end if

	call exportvec(vec2(mth(seedind(1):sit,:)),"matth2.txt",1)
	call exportvec(vec2(matthshape(seedind(1):sit,:)),"matths.txt",1)
	call exportvec(lr(seedind(1):sit),"lrtests.txt",1)

end do
end program main_lr_st